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(57) Abstract 

Methods and apparatus are provided for locating the position, preferably in three dimensions, of a sensor (7) by generating 
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posit? on T.nraiTnN system 

The present invention relates to methods of and 
apparatus for, determining the location of an object and in 
particular, but not exclusively to methods and apparatus 
5 which employ a magnetic field which is sensed at the object. " 

It has been long appreciated that if the magnetic 
field around a field generating element, for example a , 
generating coil, can be accurately mapped then it might be 
possible to determine the location of a field sensor, for 

10 example a sensing coil, relative to the generating coil, from 
the signals sensed by such a sensing coil. However, a 
problem associated with doing this is that there are in 
general many locations and/or orientations of the sensing 
coil within the field of the generating coil that will 

15 provide the same characteristic sensing signals in the 
sensing coil. In order to use a magnetic field for this 
purpose, additional information must therefore be provided. 

Prior art approaches to providing the additional 
information required comprise either moving the generating 

20 and sensing coils relative to each other, or scanning the 
axis of the generated field past the sensing coil. 

An example of the first approach is taught .in US 
3,644,825 wherein a system is disclosed for locating the 
position of a field sensor, comprising two orthogonal sensing 

25 coils, relative to a field generating element which relies on 
having knowledge of the direction of motion of the sensor 
relative to the generator. It should be noted that this 
system cannot detect the location of an object unless there 
is such relative motion, and its direction is known. 

30 The second approach of scanning the axis of the 

generated field is disclosed, for position location in two 
dimensions, ir. US 2, 121, 228 and for position location in 
three dimensions in US 3, 868, 565. 

US 3,121,228 describes how the distance and direction 

35 of a sensor, again comprising two orthogonal sensing coils, 
relative to a field generator, also comprising two orthogonal 
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coils, can be determined. The two orthogonal generating 
coils are driven in phase quadrature so that the axis of the 
resultant field is caused to rotate within a plane. If the 
sensor is located within this plane then the axis of the 
5 field is guaranteed to scan past the sensor, and, because at 
any given distance from a field generator the field strength 
will be a maximum at the field axis, the sensor will detect 
a maximum in field strength at this time. The voltage 
induced in any one of the two coils forming the sensor will 

10 be dependent on the orientation of the coil relative to the 
field generator, and it is for this reason that in ' 228 two 
orthogonal coils are utilised in the sensor. The sum of 
these two voltages gives an indication of the distance 
between the sensor and generator, while the phase difference 

15 between the two voltages gives an indication of the direction 
of the generator relative to the sensor. It is thus 
essential to the operation of the location system of '228 
that the axis of the field rotates and that two coils are 
present in the sensor. 

20 In US 3,868, 555 this approach of scanning the axis, or 

maximum intensity vector, of the field past the sensor is 
extended to allow location of the sensor in three dimensions. 
Whereas in two dimensions it is sufficient merely to rotate 
the axis of the field within the plane to be sensed to 

25 guarantee it passing through the sensor, in three dimensions 
the axis would have to be rotated so that it described the 
surface of a sphere in order to be certain it encountered the 
sensor. To ensure that the axis passed through all points on 
the surface of a sphere the motion of the axis would be such 

30 that it encountered the sensor only very infrequently, and 
thus measurements by the sensor of the maximum field strength 
would also be infrequent. To avoid this the location system 
of ' 565 drives the generator coils in a complex fashion so 
that the field axis -racks and rotates around the position of 

35 the sensor. 

In order to locate the position of the sensor in three 
dimensions, according to the method of ' 565, three mutually 
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orthogonal generating coils and three mutually orthogonal 
sensing coils are required and the three generating coils 
must be. driven simultaneously by the three drive currents 
having amplitude and phase relationships between them, which 
5 are controlled so as to direct the field axis towards the 
sensor. 

The approach taken in ' 56 5 further requires that the 
various equations, governing the voltage induced in a sensing* 

- coil located and orientated in a particular alternating 

10 magnetic field are solved dynamically in real time ie. during 
the acquisition of data from the sensing coil. This 
requirement, in addition to limiting the speed at which the 
sensor can move while still being located successfully by the 
system, also means that should it be desired to locate more 

15 than one sensor, all apparatus will need to be duplicated for 
each additional sensor. 

According to a first aspect of the present invention 
there is provided a method of determining the location of a 
field sensor relative to a plurality of field generators of 

20 known location, each field generator comprising a plurality 
of co-located field generating elements, the method 
comprising the steps of: 

1) for each generator, energising each generating 
element and measuring the respective field 

25 generated by each generating element at the field! 

s ens or, 

2) for each field generator calculating, from the 
measurements of the fields generated by each of 
its generating elements, an estimate of the 

30 distance from that particular field generator to 

the sensor, and 

3) utilising the estimates of the distances from 
each of the field generators to the sensor, and 
the known location of the field generators to 

35 calculate the location of the sensor relative to 

the field generators. 
The method of the first aspect of the present 
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invention thus enables the location of a sensor to be 
determined without either relative motion between the sensor 
and the field generating element, or scanning of the axis of 
the field. 

5 Since the method dissociates the stages of acquisition 

of data from the sensor, and processing of that data, rapid 
. determination of the sensor location is facilitated. 
Furthermore the location of additional sensors may be 
determined simply by simultaneous measuring the . field, 
10 generated by each generating element, at these other sensors 
and independently calculating their distances from the field 
generators. It should be noted that no modification of the 
field generating apparatus or method of driving the apparatus 
is required in order to determine the location of a plurality 
15 of sensors. 

The applicants have discovered that advantageously the 
method of the first aspect of the present invention also 
allows the location of a sensor comprising a single sensing 
element, for example a sensing coil, to be determined, as 
20 will be explained subsequently. This is particularly 
advantageous for positioning applications in which two or 
more mutually orthogonal sensing coils, as required by prior 
art techniques, cannot be used. 

According to a second aspect of the present invention 
25 there is provided a method of determining the location of a 
field sensor, comprising a plurality * of co-located field 
sensing elements, relative to a field generator, comprising 
a plurality of co-located field generating elements, the 
method comprising the steps of: 
30 1) energising a single field generating element to 

establish a field, 
2) measuring a value of the field strength at the 
field sensor which is dependent on the location 
and orientation of the sensor within the field, 
2 5 3) repeating steps 1) and 2) for each field 

generating element, 
4) calculating, by utilising all the values measured 
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in step 2 and an estimate of the location of the 
sensor, an estimate of the field strength B that 
would exist at the sensor if the axis of the 
field were directed towards the sensor, and 
5 5) maximising the value of B by iteratively altering 

the estimate of the location of the sensor until" 
the location of the sensor relative to the field 
generator is found to a desired level of • 
accuracy. 

10 This aspect of the invention thus provides a method of 

locating a sensor relative to a single field generator. 

The invention further provides apparatus suitable for 
carrying out the methods of the first two aspects of the 
invention. 

15 Preferred embodiments of the present invention will 

now be described, by way of example only, with reference .to 
the accompanying figures in which: 

Figure 1 shows a first embodiment of the invention, 
Figure 2 shows the cartesian coordinate system 
20 employed for a sensor of arbitrary orientation located at 
point P, 

Figure 3 shows schematically the resolution of the 
mag'netic flux density at a sensor, 

Figure 4 shows the coordinate system employed to 
25 locate a sensor relative to a field generator, 

Figure 5 shows schematically a simulated circle of 
constant induced voltage, in a sensor, in two dimensions, 
. which is employed in the first embodiment of the invention 
Figure 6 shows schematically three simulated spheres 
30 of constant induced voltage each centred on a field 
generator, which is employed in the first embodiment of the 
invention. 

Figure 7 shows a flow chart of a first positioning 
algorithm used in the first embodiment of the invention, 
3 5 Figure 8 shows the same schematic as Figure 6 when the 

location and orientation of the sensor have been determined, 

Figures 9, 10 and 11 schematically show a coordinate 
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system employed in a second positioning algorithm used in the 
first embodiment of the invention, 

Figure 12 shows images of an endoscope obtained using 
the positioning system of the present invention on the left, 
5 and images obtained conventionally using X-rays on the right, 
(a) shows a sigmoid loop, (b) shows an alpha loop, and (c) 
shows a reverse alpha loop, 

Figure 13 shows images of an endoscope within a 
patient obtained using the present positioning system on the 
10 left, and obtained using conventional X-ray imaging on the 
right, (a) shows an anterior view, and (b) shows a lateral 
view. 

Figure 14 shows a second embodiment of the invention. 

In a first embodiment the invention enables a sensor 
15 comprising a single sensing coil to be located in three 
dimensions relative to a plane defined by three field 
generators.. 

With reference to Figure 1, three field generators 1 
are mounted at known locations on a plane surface 2. Each 

20 field generator 1 comprises three electrically separate coils 
of wire (generating coils) 3 wound about a cuboid wooden 
former 4, which is approximately 40mm along one side. The 
three coils of each field generator are wound so that the 
axes of the coils are mutually perpendicular. The nine 

25 generating coils are separately electrically connected to an 
amplifier 5 which is able, under the direction of a 
controller 6, to drive each of the coils individually. Each 
coil comprises 40 turns of 0. 4 5mm copper wire and has an 
inductance of approximately 75iiH. 

30 The sensor 7 comprises a single sensing coil of 200 

turns of 42swg wire on a f errite core of diameter 0. 8mm, and 
length 12mm. Larger sensor coils will in general be more 
sensitive to the eiectro-magnetic fields generated by the 
generating coils, however the size of the coil is normally 

35 governed by the particular position location problem which is 
being addressed and frequently small sensor coils will be 
required. For an air-cored coil the sensitivity, of the 
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sensor depends on the area of the coil, however the 
sensitivity can be increased by utilising a high magnetic 
permeability material in the core, and in this case the 
sensitivity will depend more strongly on the length of the 
5 coil than on its diameter. The sensing coil is electrically 
connected to a measurement unit 8 which in turn is connected 
to the controller 6. The measurement unit 8 comprises an 
analogue to digital converter, and a" matched filter (not' 
shown). 

10 In use, the controller 6 directs the amplifier 5 to 

drive each of the nine generating coils 3 sequentially. The 
amplifier 5 outputs a 10kHz drive signal of 3amps rms which 
causes the particular generating coil being driven to 
generate a quasi -static magnetic field. The frequency of the 

15 drive signal is chosen so that, within the range over which 
the location of the sensor is to be determined, the field 
generated is a near-field electro-magnetic field i. e the 
wavelength is long compared to the distance from the 
generating coil to the sensing coil. 

20 Furthermore the drive signal frequency must be chosen 

so as to provide a compromise between sensor coil 
sensitivity, and the detrimental effects of electro-magnetic 
noise due to induced eddy currents within electrically 
conductive objects within the positioning range, since both 

25 of these aspects increase with frequency. In the absence of 
electrically conducting objects a frequency of several 
hundred kilohertz may be used giving good sensor sensitivity 
and thus good range and positioning accuracy. In the 
presence of highly conductive objects, this frequency may 

30 need to be reduced to a few hertz. In this case a sensor 
coil may no longer be appropriate and may be replaced by an 
alternative magnetic field sensor, such as a flux gate 
magnetometer. In this embodiment a drive frequency of 10 kHz 
has been found to be a suitable compromise between 

25 sensitivity and immunity to interference from electrically 
conductive objects. 

Once the quasi-static field from a particular 
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generating coil 3 is established, the value of the voltage 
induced in the sensing coil 7 by this field is measured by 
the measurement unit 8. The signal from the sensing coil 7 
is first amplified and then sampled at 40 kHz by a. 16 bit 
5 analogue-to-digital converter. The sampled signal is 
windowed using a Blackman-Harris window, the 10 kHz component 
is extracted by the matched filter and hence a value 
representing the voltage induced in the sensing coil 7 is 
established. This value is passed to the controller 6 which 

10 stores the value and then instructs the amplifier 5 to stop 
driving the present generating coil 3 and to start driving 
the next generating coil 3. When all nine generating coils 
3 have been driven, or energised, and the corresponding nine 
voltages induced in the sensing coil 7 have been measured and 

15 stored, the controller 6 calculates the location and 
orientation of the sensor 7 relative to the field generators 
1 and displays this on a display device 9. This calculation 
can be carried out while the subsequent set of nine 
measurements are being taken. Thus, by sequentially driving 

20 each of nine generating coils 3, arranged in three groups of 
three mutually orthogonal coils, the location and orientation 
of a single sensing coil 7 can be determined. 

In order to describe the algorithm employed by the 
controller 6 to calculate the location and orientation of the 

25 sensor 7, a coordinate system will first be defined. In 
Figure 2 is shown a sensor, located at position P, whose axis 
is orientated along direction S. In general in order to 
determine the location and orientation of a single sensing 
coil within a field the x, y, z cartesian coordinates of the 

30 sensor and the elevation angle 6, and rotational angle <|>, 
must be found (see Figure 2). The vector distance R of the 
sensor from the origin, 0, of the coordinate system is also 
shown in Figure 2. 3oth the location and orientation of the 
sensing coil within rhe field will affect the voltage induced 

3 5 in the coil by the field, but rotation of the coil about its 
axis will not affect the induced voltage and thus does not 
constitute a further unknown quantity. 
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Assuming now that a single field generating coil 3 is 
placed at the origin O of the coordinate system with its axis 
directed along the 2 -axis. When the generating coil is 
energised a field will be produced at the sensor location P 
5 which has a magnetic flux density B. With reference to 
Figure 3 this magnetic flux B can be resolved along the three 
axes of the coordinate system to give Bx,. By and Bz and 
-subsequently resolved along the axis of the sensor thus: 

B I? = B I cos <fr + 3 y sin 4> ... (1) 

1 0 and 

h s = B 2 cos 6 + B xy sin 6 ... (2) 

The voltage V 5 , induced in the sensor is related to the 
flux density via V : = k, B 3 where k. is known and is a function 
of the frequency of the field and the characteristics of the 
15 sensing coil. It therefore follows from (1) and (2) that the 
voltage induced in the sensor at any x-y-z location and for 
any 6-4> orientation is given by, 

V s = k J (B I cos 6 + sin Q(h x cos <J> + B y sin <J>)) ... (3) 

Formulae defining B x , B y and B 2 are developed from 
20 standard near field electromagnetic theory in Appendix-A. 
Upon substituting the terms for B x , B y , B z from equations (A- 
12) to (A-14) into (3), it can be shown that, 



V s = k £ k, 



f2z 2 - x 2 - v 2 l cosS ♦ 3z sinOfx cos* * v sinchll . (4) 



(x 2 ♦ y 2 + z 2 ) 



2^5/2 



25 where k e is known and is a function of the current through, 
diameter of, and number of turns on the generating coil. The 
five unknown quantities, x, y, z, 6 and (J> are evident in (4): 
ail other variables are known. 

Equation (4) has been derived, as stated above, for 

30 the case of a single generating coil 3 directed along the z- 
axis, there will of course be a corresponding equation for 
each of the three generating coils 3 of each of the three 
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field generators 1. 

It has been found that despite the complexity of this 
term (4) it is possible to determine the location and 
orientation of a single sensing coil by sequentially 
5 energising each generating coil. To explain this approach to 
position location the two dimensional case will first be 
considered. 

Figure 4 shows a field generator comprising two 
orthogonal field generating coils D, and D y located at the 
origin of the coordinate system. The single sensing coil 
sensor, is located at P and its axis is parallel to direction 
S. The angle a is the angle between vector direction R of 
the sensor from the origin, and the direction S of the sensor 
axis. 

The voltages induced in the sensor when coils D x and D y 
are energised sequentially are respectively, 



15 



and 



V ,0i = M B RDX C0Sff - B 6Di sina) 

v ,o, = M b rd, cosa - B eo, sina) 



. (5) 
... (6) 



20 where the D x and D y sub-suffices relate to the field generated 
by the D, and D coils. Upon substituting (A-l) and (A-2) 
- from Appendix- A, (5) and (6) become, 

V j0x = jytj (2cos9 cosa - sin6 since) ... (7) 



25 and 



V 0 = kfj^ (2sin8 cosa + cos6 sina) 



. (8) 



It has been noticed that the value of /v s0i 2 ♦ V sDy 2 
remains constant for a constant value of a. 
3 0 From (7) and (8) we can write, 



sDx 



- V 



4 c os : 9 c os : a + s i n-9 s i n" a 
-4sin9sinacos9cosa 

+4sin : 9cos 2 a + cos 2 9sin 2 a 
+4sin9cos acos9sina 



(9) 
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which r educes to, . 

/v s0x 2 + V aDy 2 = k c Jc s / 1 - 3cos : a ... ( 10 ) 

R 3 " 

This can be thought of as corresponding physically to 
5 a circle of constant induced voltage in the sensor, centred 
on the field generator at the origin and lying in the x-y 
plane. This concept is shown schematically in Figure 5. If 
the two individual measurements of induced volta ge V sDl and V sD ,' 
measured at the sensor are used to calculate /v j0l 2 + V j0y 2 a 

10 circular or rotating field of constant strength can be 
simulated since /v i0 / + V jDy < represents the maximum voltage 
that could be induced in the sensor if a rotating field were 
used. This is desirable since equation 10 gives a very 
simple relationship between R and a. 

15 The extension of this analysis to three dimensions Is 

readily performed mathematically and conceptually very 
powerful because the approach taken does not require the axis 
of the generated field to be steered towards the sensor, but 
simply requires sequential energising of the individual 

20 generating coils. Thus for position determination in three 
dimensions of a single coil sensor, assuming three mutually 
perpendicular generating coils located at the origin of the 
coordin ate system, we hav e 

/V *D, 2 + W + V 3D/ = *A H + 3COs2tt ..-(ID 



It should be noted that the term V 1 + 3cos : o can only 
take values between 1 and 2, ignoring negative solutions and 
thus any value of R computed from (11) is only weakly 
dependent on the value of a. For example, if o is assumed to 

30 be n/2 whereas its correct value is zero, the value of R 
computed from (11) is 80% of its correct value. Th is in fact 
represents the worst case scenario since ct=0 means /l + 3cos 2 o 
= 2, while o=n/2 means vi - 3cos~a = 1. 

Hence for each of three field generators a bounded 

35 value for R, the vector distance of the sensor from that 
particular field generator, can be calculated without any 
knowledge of the orientation a of the sensor. Since there 
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are three field generators located at different known 
positions in the same plane (the x-y plane) and the distance 
R from each of them to the sensor has been calculated, the x- 
y-z coordinates of the sensor can be determined from simple 
5 trigonometry. This positioning methodology is shown 
schematically in Figure 6. The three simulated spheres of 
constant induced voltage centred on each of the three field 
generators, and bounded by the potential error in R, overlap 
at two regions. One region is above the plane of the field 
10 generators and the other is below. In most applications, one 
solution is clearly erroneous and the location of the sensor 
can easily be uniquely determined. 

At this stage the location of the sensor (but not its 
orientation) has been calculated to a limited degree of 
15 accuracy. For some applications this may be adequate, but in 
general the precise location and probably orientation of the 
sensor are required. This is achieved by the use of an 
iterative procedure in which the estimate of the x-y-z 
coordinates of the sensor, derived from the values of R for 
20 each of the three field generators, are used in the 
appropriate equation (4) for each of the nine generating 
coils to estimate values of 6 and $ for the sensor, from 
these o is calculated for each of the three generators. 
Although 6 and * could be calculated from only two versions 
25 of equation (4), all nine versions are employed to improve 
the rate of convergence of the solution and its immunity from 
noise. The three values of a can then be invoked in the 
appropriate equation (11) for each field generator to 
calculate an improved estimate for R for each of the 
30 generators. This process is repeated, progressively reducing 
the error in R and o for each generator until the desired 
level of accuracy is achieved. It should be noted that this 
technique avoids the problems of non-convergence which would 
arxse if equation (4) were utilised directly because a good 
estimate for R has been found before equation (4) is. 
employed, and the estimate for R is bounded as shown 
schematically in Figure 5. 



25 
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In summary, and with reference to Figure 7, the 
algorithm utilised by the controller 6 is as follows: - 
1. Assume a=0 initially. This ensures an over-estimate 

of R which guarantees an intersection of the radial 
5 distances from the three generator. 

2; Measure the voltages induced in the sensor by each of 

the 9 individual generator coils, and then compute 

/v 2 + v 2 + v * for each of the three generators. 

sDx JOy sDz 

3. Invoke a in (11) and compute R for each of the three 
10 generators. 

4. Compute the x-y-z coordinates of the sensor from the 
three values of R. 

5. Invoke these coordinates in the appropriate version of 
equation (4) for each of the nine generating coils and 

15 compute an improved estimate of 6 and 4>. This can 'be 

achieved by the use of, for example, the Gauss-Newton 
Least Squares optimisation technique. 

6. Use the improved estimates of 6 and <t> to calculate a 
. for each generator. 

20 7. Return to step 3 until the difference between the new 

and previous estimates of a reaches a sufficiently low 
value commensurate with the required positional 
accuracy in the x-y-z coordinates being achieved. 
Figure 8 depicts schematically the three spheres of 
25 constant induced "voltage when the errors in R have been 
reduced to allow the location of the sensor to be determined 
uniquely. The technique employed thus guarantees convergence 
■ to a unique location, with a precision that can be chosen in 
accordance with the requirements of the application. Indeed, 
30 it should be noted that in applications where the sensor is 
moving within the magnetic field, the number of iterations 
can be chosen dynamically for each calculation of the 
location of the sensor, thereby improving the efficiency of 
the process. For example, the first placement of the sensor 
35 typically requires 10 iterations before the solution is 
considered to have converged: this is considered to be so 
when the mean-square difference between the present and 
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previous values of a is less than 10' 6 . Even with rapid 
movements of the sensor, it is unlikely that its angle o will 
change markedly from one positional placement to the next. 
By using the final value of a arrived at during the first 
5 placement as the initial estimate in the second placement, 
the number of iterations required to achieve the same 
convergence is significantly reduced. And so on for all 
subsequent placements. Experiments have shown that as few as 
3-5 iterations are required for convergence after the initial 
10 placement. 

Although the algorithm described above with reference 
to Figure 7 ensures convergence to a unique location, allows 
both the location and orientation of a single coil sensor to 
be determined, and has proved to be robust even in the 
15 presence of noisy signals from the sensor coil 1, a second, 
alternative algorithm has been developed which has further 
advantages . 

The first algorithm requires, at step 5, the solution 
of nine simultaneous equations relating 6 and <t> for each of 

20 the field generators to the estimate of the x, y and z 
coordinates of the sensor. This calculation can, dependent 
on the processing power of the controller 6, be time 
consuming, hence a second algorithm which is less 
computationally intensive has been developed. This algorithm 

25 enables the location and orientation of the sensor 7 to be 
determined more rapidly. The second algorithm is based on 
the realisation that mathematically the voltages induced in 
the sensor 7 by each set of three generating coils 3 
comprising each generator can be treated as vector 

30 quantities. This mathematical treatment enables an angle $ 
between the magnetic field lines and the direction vector of 
the sensor from a generator to be calculated. Once the 
values of for each generator have been found there is no 
need to employ equation (4) since the values of a can be 

35 calculated directly from the values of $ given a knowledge of 
the form of the magnetic field. Since nine versions of 
equation (4) need no longer be solved this algorithm is 
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computationally less intensive than the algorithm of Figure 
7. 

The second algorithm will now be described in greater 
detail. In order to explain the algorithm clearly and to 
5 demonstrate the mathematical insight on which it is based, 
the roles of the generating coils 3 and sensor coil 7 will be 
reversed i. e. for the purpose of the calculation the single 
axis field sensor 7 will be replaced by a continuously 
energised single axis field generating coil and the three 

10 orthogonal three-axis field generators will be replaced by 
three orthogonal three-axis field sensors. This is shown in 
Figure 9. Although it should be stressed that the reversal 
of roles here is simply for the purpose of mathematical 
elegance, this reversed configuration will in practice be 

15 feasible and in some position location applications may be 
desirable. 

Referring now to Figure 9, let the vectors joining 
each three-axis sensor (10) to the single axis generator (11) 
be E u E 2 and E 3 and let the angles between these vectors and 

20 the generator be a,, a 2 and a 3 . The field produced by the 
single axis generator (11) will pass through each three-axis 
sensor (10), and the magnitude and direction of the field may 
be determined by processing the signals produced by each of 
the three orthogonal sensor coils (12), forming each three- 

25 axis sensor (10), in response to the field. Let the signals 
in each of the three-axis sensor (10) be represented by the 
vector quantities Vj, V 2 and V 3 , where each component of the 
vectors corresponds to the signal in each- of the orthogonal 
sensing coils (12). Let the angle between the field at each 

30 three-axis sensor (10) and the vectors R 1# & 2 and fc 3 be * 2 
and t|i 3 respectively, as shown in Figure 10. 

For the first estimate of the position of the 
generator 11, the orientation of the generator (11) is 
unknown, and a., a 2 and a 2 are assumed to be zero. The 

35 magnitude of the vectors R,, and Rj and Rj are then calculated 
from equation (11). As for the first algorithm, because of 
the nature of equation (11) a bounded value for the distance 



WO 94/04938 



- 16 - 



PCT/GB93/01736 



of the generator (11) from each of the three-axis sensors 
(10) is found and the overlap of these bounded values can be 
used to give an initial estimate of the x, y and z components 
of each of the vectors Ei» £2 and £3- 

The angles V *2 and *3 then calculated tne 
dot product, as follows: 

V n . ^ = I vj I rJ cos1» B 



10 cost|r D 



15 



V 1 R n- 



Having found li n , we need to find o n to improve the 
estimate of position. Referring to Figure 11 * is the known 
angle and o is the required angle, d represents the 
calculated distance from the generator to the sensor. 

Since the generator is a simple, dipole, the field at 
the sensor is given from equations (A-l) and (A-2) of the 
Appendix by: 



20 =( 2k I cos a 



1* 

B «s IkJ sina 

' VI 

The angle of the field at the sensor is given by: 
25 tanty = -B = _ 1 tana 

-C 2 

and so o is obtained from i|r using: 
tana. =-2tani|r. 

Having found a new estimate for a n , a new estimate of 
20 the generator position is calculated using equation (11). 
The process is repeated until the position converges to the 
required degree of accuracy. 
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Once the position of the generator (11) has been 
determined in terms of JL and a„ the orientation of the 
generator may be calculated in terms of 8 and (J> as follows. 

Let D be a unit vector defining the orientation of the 
5 generator relative to the sensors. Using the dot product, we 
can set up three equations to determine the three unknowns in 

R^IL =1 rJ I u! coso, = I rJ cose, 



10 



Ij.JL =1 rJ I al cosa 2 = I rJ 



cosa- 



3 . H =1 rJ I III coso 3 = I rJ 



cose 



These linear equations are solved to find and then 
15 the orientation in terms of 6 and $ is given by: 

^ 



6 = arctan 



20 



25 



30 




(note that a four quadrant arctan function should be used). 

Although the formulation of the second algorithm has 
thus far been for the case of a single axis generator and 
multiple axis sensors the algorithm can be applied to the 
case of a single axis sensor and multiple axis generators. 
The only modification required between the two cases is the 
method by which the raw data for the algorithm (i. e. the 
voltages induced) is acquired. The equations developed above 
are directly applicable to the single axis sensor multiple 
axis generator case since the magnetic coupling between two 
coils is the same irrespective of which of- the two coils is 
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being driven. 

The steps to be followed when employing the algorithm 
for the single axis sensor and multiple axis generator case 
will now be summarised: - 

1. Sequentially energise each of the three generator 
coils in each of the three generators 1 and 
measure the voltage induced in the sensor coil 7 
by each generator coil i. e. measure V lx , V ly , V J2 , 

V 2,< V V 2*' V 3" V V 3'' 



10 2. Invoke a n in equation (11) and compute I R n l for 

each of the generator 1, 2 and 3. (for initial 
estimate set a=0). 



3. frpm the intersection of three spheres of radius 
calculate the vector quantities B% and R3. 



15 4. Taking the three voltages induced in the sensor 

coil 7 by a single generator 1 as a vector 
quantity e. g. 

calculate the angle of the field from the dot 
20 product Vn-En- 

5. Calculate the angles a n between the vectors ^ and 
the sensor axis from Tjr n and equations A-l and A- 
2. 

6. Repeat steps 2 to 5 until the desired level of 
25 positioning accuracy has been achieved. 



7. Use final values of a n and to calculate the 
orientation of the sensor coil in terms of 8 and 

It has been found that use of the second algorithm can 
30 improve the speed with which the location and orientation of 
a sensor is determined, by a factor of approximately 15 
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compared to the first algorithm. 

For both algorithms the location and orientation of 
more than one sensor can be determined without the need to 
replicate the field generators 1 and amplifier 5. The field 
5 generated by any one field generating coil is measured at 
each of the sensors and the location and orientation of the 
sensors are simultaneous and independently calculated. The 
positions of the sensors may of course all be displayed on a' 
single display unit 9, 

10 The simple, small sensor used in this embodiment means 

that it can provide position location in many situations 
where there is insufficient space for the three coil 
orthogonal sensor used in prior art position location 
systems, A particular field of application is the medical 

15 field, where access through body vessels is required, for 
example in endoscopy or non-invasive cardiovascular heeirt 
surgery. In these medical situations the present location 
system may replace the use of x-ray imaging (fluoroscopy), 
giving considerable advantages in cost and eliminating x-ray 

20 exposure to both patients and medical staff. The low 
frequency magnetic fields used by the present system render 
the human body transparent, while the use of low field 
strengths ensues the system is intrinsically safe. 

During endoscopy it is desirable to know the path of 

25 the endoscope through the body. This may be achieved using 
the present location system in three ways. Firstly, the 
single sensing coil may be pulled along the biopsy tube and 
its position at regular intervals along the tube stored and 
displayed to provide a 3D map of the path. Secondly, a tube 

30 containing approximately a dozen single coil sensors may be 
placed in the biopsy tube of the endoscope and the location 
of each of the sensors determined. This would be a retro-fit 
to existing endoscopes. Alternatively, the single coil 
sensors may be placed in the wall of the endoscope during 

35 manufacture. In the second two cases a real time picture of 
the path of the endoscope would be available at all times to 
the endoscopist. 
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The present positioning system has been utilised in 
clinic field trials to image in three dimensions the total 
configuration of a colonoscope within the human abdomen. A 
sensor according to the present invention was placed inside 
5 the biopsy channel of an endoscope. 

The small inner diameter of the biopsy channel, 
typically 3. 7mm for a colonoscope, not only dictates that the 
sensor be of vanishingly small diameter, but also that it may 
only comprise a single coil, typically 1cm in length, 

10 orientated along the axis of the instrument. The algorithms 
of the present positioning system processes the signals from 
this sensor in such a way as to calculate the position of the 
sensor within the biopsy channel independent of its 
orientation. Such independence is crucial in colonoscopy 

15 since the sensor may adopt any orientation for a single x-y^z 
location. 

The positioning algorithm resides as software within 
an IBM 486 personal computer which, upon processing the 
information taken from the sensor at numerous discrete 

20 positions along the biopsy channel, then displays the path 
followed by the sensor as a continuous line on the monitor. 
Clearly this path corresponds precisely to that of the 
endoscope. Moreover, because the information from the sensor 
'at each location relates to three dimensions, the imaged path 

25 on the monitor is likewise displayed in three dimensions. 
Visually the system achieves this by the use of "grey scale" 
colour coding whereby portions of the path further from the 
viewer (i.e. down into the screen) appear in darker shades of 
grey than the "under" portion. This feature is unique among 

30 all conventional imaging techniques for colonoscopy and 
represents a major advance in the field. 

To display the path of the endoscope, the endoscopist 
first passes the sensor down the biopsy channel until it 
reaches the tip of -he endoscope. For convenience we have 

35 encapsulated the sensor within a hollow tubular catheter of 
the type used routinely with endoscopes. The catheter is 
then withdrawn at a uniform speed (although this . is not 
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critical) while the system repeatedly determines the position 
of the sensor at discrete instances during its motion. 
During withdrawal the path of the instrument is displayed on 
the monitor in three dimensions. In many situations a total 
5 image of the endoscope is not required, in which case the 
sensor need only be withdrawn along that portion of the 
instrument of interest. To cater for patients lying in. a 
variety of positions, perhaps changing during the- 
- investigation, the image may be rotated in any direction. 

10 This is particularly advantageous in establishing the radius 
of curvature of any bend in the endoscope that happens to lie 
along the viewing axis. For example, a bend that is in fact 
gradual, and hence poses no concern, can appear abrupt if 
viewed from some directions. A useful 200m facility on the 

15 image is also provided. When the system is in normal u^e, 
the system display would ideally be sited next to a standard 
camera monitor used to display the view from the endoscope. 
In this way the endoscopist is conveniently presented with 
the path of the instrument in three dimensions on one 

20 display, and the internal view from the endoscope optics on 
the other. 

Initial validation of the system was performed with 
the aid of a rigid plastic framework to hold the endoscope in 
one of a number of predefined configurations. X-ray imaging 

25 and the present magnetic field system were applied to seven 
different configurations of the endoscope. These included a 
sigmoid loop, an alpha loop, a reverse alpha loop, a gamma 
loop, and an " N H loop. The results, three of which can be 
seen in Figure 12 showed close agreement between the- image 

30 produced by the present positioning system (shown on the 
left) and the X-ray image (shown on the right) in each case. 
The nature of the overlapping portions of the colonoscope can 
be clearly seen from the images produced by the present 
positioning system. Some distortion of the images was caused 

3 5 by the metallic construction of the colonoscope perturbing 
the magnetic fields. However, this was minimal and the 
colonoscope configuration is clearly evident from the images. 



WO 94/04938 



- 22 - 



PCT/GB93/01736 



.The clinical trails involved three patients undergoing 
colonoscopy for a number of different indications. Ethical 
approval was obtained, as was written consent- The patients 
were sedated -with a combination of pethidine and midazolam 
5 before ,the examination. The col onos cope used was a Pentax 
type FC3 8LH. 

For the majority of each examination, the sensor was 
fully inserted into the biopsy channel, and the display was 
configured to show the progress of the tip of the endoscope 

10 in real time. When progress became difficult, the sensor was 
withdrawn, which immediately produced an image on the screen 
of the total path of the endoscope. With the aid of this 
image the removal of loops was straightforward, by using 
clockwise or anti -clockwise twist and simultaneous withdrawal 

15 of the endoscope. Similarly, when re-inserting .the 
instrument the reformation of loops was prevented by a 
combination of abdominal pressure and torque. Where 
abdominal pressure was required the sensor was positioned in 
the loop, so enabling the endoscopist to see, by referring to 

20 the displayed image, whether pressure was being applied in 
the desired direction and to the correct extent. In each 
case examination around to the caecum was achieved (i.e. 
total colonoscopy) and the procedure was tolerated well by 
the patients. During the examinations, X-ray pictures were 

25 taken for comparison against those obtained with the magnetic 
system. Two of these, a plan and side view, are shown in 
Figure 13 together with the corresponding image from the 
magnetic system. Agreement between the two is very close, 
the deviation being largely attributable to patient movement 

30 between the two exposures. 

The system has been shown to image the configuration 
of the endoscope within the patients' s abdomen with close 
agreement to the X-ray image. The three dimensionality of 
the image has proven zo be of great help in deciding the 

35 strategy for removing loops which form in the path of the 
endoscope during intubation. Indeed, this improvement in 
visualisation is likely to be of great benefit in teaching 
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colonoscopy, as well as enabling experienced endoscopists to 
improve their technique when facing difficult cases. The 
intrinsically safe nature of the system allows it to be in 
continuous use throughout the examination, presenting the 
5 endoscopist with as many images as the circumstances require. 
This contrasts markedly with fluoroscopy which can only offer 
images intermittently and carries an exposure time limit for 
reasons of patient safety, and X-ray pictures which are 
essentially only a "one-shot" option. Moreover, protective 

10 clothing need not be worn by any of those present at the 
examination while the system is in use, nor is it necessary 
for the examination room to be in any way specially prepared. 
Indeed, the system frees such examinations from having to 
take place in a room apart from the ward. If need be such 

15 examinations could be carried out in complete safety and with 
no loss in overall integrity, at the patient' s own bed in the 
ward. 

A number of medical studies have considered the 
efficacy of colonoscopy as a screening methodology in 

20 asymptomatic subjects and have shown a significant detection 
rate for adenomas and carcinoma in subjects over the age of 
60. Of particular note here is that some 50% of lesions were 
proximal to the splenic flexure, hence the importance of 
performing a total colonoscopy in such cases. The ability to 

25 conduct total colonoscopes routinely and efficiently is 
therefore an important objective. On the other hand it must 
be remembered that colonoscopy (total or otherwise) is 
associated with a certain morbidity and mortality due to the 
need to apply mechanical stress during intubation or 

30 withdrawal. The overall improvement in visualisation that 
the present system affords, particularly it's three 
dimensionality, should both raise the efficacy of total 
colonoscopy and reduce the risk of perforation. This in turn 
may also help to reduce the dosage of analgesic and sedative 

35 drugs required. 

Although the application of the present positioning 
system to colonoscopy has been specifically addressed, the 



WO 94/04938 PCI7GB93/01736 

- 24 - 

scope of the medical applications expends far beyond this by 
virtue of the very small size of the sensor(s). For example, 
bronchoscopy, gastroscopy and procedures involving a 
nasogastric or endotracheal tube could all utilise the sensor 
5 described herein its present catheter form. Numerous other 
medical applications requiring position or orientation 
information could benefit from either a single or multiple 
sensor implemenration of the system. 

Data gloves which facilitate the location of a 

10 wearer' s hands, are used in both medical and virtual reality 
applications. They enable the position and direction of each 
of the fingers to be determined. The prior art magnetic 
field location system using a three coil orthogonal sensor is 
clearly not applicable, so current data gloves use fibre 

15 optic strain gauges. These require calibration every 2-3 
minutes. The ability to locate single coil sensors means 
that the sensors may be wound around each joint of each 
finger giving a system which is less bulky, more accurate and 
only requires calibration during the manufacture of the 

20 gloves. 

A particular area of application for the present 
positioning system comprises that of the so called "man- 
machine interface". There are numerous situations in which 
a human operator needs to interact with a machine, or 

25 computer, normally comprising some form of display device, 
examples of such interactions are with a conventional 
personal computer, a video conferencing system, or a virtual 
• reality environment in which the operators field of view is 
filled by the display device, which in this case may be three 

30 dimensional. The present positioning system allows an 
operator to wear small, single coil sensors about his body to 
enable his movements to be detected and interpreted by a 
machine without the need for physical contact between the 
operator and the machine. For example the positioning system 

2 5 of the present invention could enable an operator to interact 
with images on a television or computer screen without the 
use of a conventional keyboard, mouse or stylus. The 
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operator could wear single coil sensors on his fingertips, 
for example in thimbles, or a thin glove, the location and 
orientation of which could be detected within a magnetic 
field generated within the vicinity of the display screen. 
5 Linking the positioning system to the computing system would 
allow the computing sysrem to have knowledge of the position 
of the operators fingertips in three dimensions, A computer 
drawn replica of the user' s hand which precisely emulates the 
movements of the user 1 s own fingers, could then be utilised 

10 by the user to interact with the computer system. Thus when 
the user makes hand movements the virtual hand on the screen 
can be made to grasp and manipulate objects in the display, 
for example moving portions of text, rotating an engineering 
drawing, selecting an icon to activate a software program, 

15 etc. The virtual hand could also be used to control windows 
and menus and to draw diagrams. The advantage of such a man 
machine interface is that its use is completely intuitive, 
requiring no training. 

Since the positioning system of the present invention 

20 enables the position of a sens.or to be located in three 
dimensions, the extension of such a man machine interface to 
a three dimensional virtual reality environment is clearly 
possible. In this case the computer system involved may need 
information regarding the position of other parts of the 

25 operator 4 s body than his hands, for example the image 
displayed to the operator may be dependent on the location 
and orientation of his head, in which case small single coil 
sensors can clearly be worn for example on each temple. 

In a second embodiment the invention enables a sensor, 

30 comprising three orthogonal sensing coils, to be located in 
three dimensions relative to a single field generator 
comprising three orthogonal generating coils. 

With reference to Figure 9, a field generator 1, 
comprising rhree generating , coils 2, as previously described 

35 is mounted on a surface 2. Each generating coil is 
electrically connected to an amplifier 5 and is driven as 
previously described. 
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The sensor 7 in this embodiment comprises three 
mutually orthogonal sensing coils, A, B and C, each of which 
is separately electrically connected to a measurement unit 8. 

In use the three generating coils are sequentially 
5 energised as previously described, but when each coil is 
energised the voltages induced in each of the three sensing 
coils V A , V B and V c are measured by the measurement unit 8 and 
stored by the controller 6. The controller 6 then calculates' 
from these three voltages the location of the sensor 7 
10 relative to the single field generator 1. 

The controller is able to calculate the location of 
the sensor, even though the axes of the generated fields have 
not been directed towards the sensor, by employing an 
algorithm which weighrs the voltages induced in the three 
15 sensing coils by a location dependent weighting, and tften 
alters these weightings to achieve a calculated maximum fifcld 
strength at the sensor. In order to more fully describe this 
algorithm the field from a single small coil is first 
considered. " 
20 The magnetic field produced by a small coil, from 

equations (A-l) and (A-2), is given by: 

£. =|k\(2£ f cos6 + sin 6) ... (12) 

where R = distance from the coil 
25 6 = angle from the axis of the coil 

k = constant for coil (size, drive current, no. turns 

etc). 

Now, the magnitude of the magnetic field 

I fi! = i /3cos 2 9 + 1 ...(13) 
30 R 3 

and so it can be seen -char for a given distance from the 
coil, the field strength is greatest when 6=0 i.e. on the 
axis of the coil. Clearly, if the effective axis of the coil 
could be directed towards the sensor, the sensor would 
35 experience a maximum in field strength. 

In order to steer the effective axis of the coil 
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without physically moving it, additional coils are required. 
To steer the effective axis over 3D, three coils are required 
in total. Assuming three mutually perpendicular coils D f/ D ? , 
D ; lying along each of the cartesian axes x, y and z, each 
5 coil being centred on the origin, by setting the currents to 
each coil as: 

I x = I cosd COS(}) 

I y = I cos6 sin<J> 

I : = I sin9 

10 the effective axis of the resulting field may be steered 
without changing the magnitude of the field. 4> is the angle 
anticlockwise from x in the xy plane, and B is the elevation 
towards the z axis. 

Assuming the notation of Figure 2, OP represents the 

15 effective axis of the field. That is a single drive coil', 
centred on the origin, with its axis along GP, fed with 
current I, would create the same field as the three coil 
arrangement with the currents I t , I ¥ and I z as described. 

Thus if the field strength at the point we wished to 

20 locate could be measured, we would find that when axis OF 
pointed at this point, the field strength would be a maximum. 

The field strength is measured using 3 orthogonal 
sense coils, centred on a single point. In this case an AC 
field must be used. in the drive coils. Let the coils be A, 

25 B and C, and let the amplitude of the voltages induced be V A , 
V g and V : . The field strength can be computed from 

B = k, (V A 2 ♦ V B 2 * v c 2 ) ' 
where k s = a constant for the sensor and frequency used. 

The effective axis of the resulting field, could be 

30 physically steered towards the sensor, and V A , V B , V c 
monitored to maximise 3. However this is difficult in 
practice to achieve since both 9 and tj> would need to be 
simultaneously altered while measurements from the sensor are 
taken. This leads to slow position location, and limits the 

25 system to locating a single sensor. The approach adopted in 
this embodiment is as follows. The drive currents for all 
the coils are set to I, and not to the values which would be 
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required to physically steer the effective field axis, as 
discussed above. 

i. e. I, = I 

I, - I ' - " 
5 ' I. = I 

Effect! velv steering of the field axis is carried out 
AFTER the field measurements have been made by weighting or 
scaling these measurements by location dependent weighting 
factors. Thus, instead of physically altering 6, <J> and then 
10 measuring B, the following technique is used. 

1. Switch on D % , with I t - I 

2. Measure V AOx , V 30x , V CDx 

3. Switch off D 4 ; Switch on D , with I y = I 

4. Measure V^, V- Dj , V CDy 

15 5. Switch off D y ; Switch on D ;> with I, = I 

6. Measure V m , V 30r , V C0: 

7. Switch off D, 

For the physically steered field: I, = I cos0cos<t>, 
rather than I. The same result is achieved by weighting the 
20 results from step 3 -by cos6cos«|>. The same logic applies to 
the remaining results, using the relevant weighting factor. 

Thus: 

B z = K^UV^, cos* ♦ V. Dy sin<t))cos6 = v ttI sin6) 2 
- ((V 80l cos* + V aDj sin4>)cos6 = V BOl sin6) z 
25 ♦ ((V COl cos* ♦ Vj,,, sin<t))cos6 = V CDz sinG) 2 

Note that the "signs" of the amplitude are important 
eg phase shift = 0 - +ve 
phase shift = it - -ve 

In this expression for B z , 9 and <J) are the only 
20 variables. 

In order ro find the values of 6 and $ which give the 
maximum B : . the Gauss -Newton optimisation technique is used. 
This copes weil with sum =f squares type expressions. The 
expression for B : is well behaved, and only a few iterations 
25 are required. 
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5 



In order to find the precise location of the sensor we 
must now find R. 

If we square and sum the .field magnitudes at the 
sensor for each generator coil, we find that: 

lid 2 - 1 12 1 1 2 • 12 



R 3 / 

10 and so R may be found from: 



The cartesian coordinates of the sensor are then 
15 x = R cos8cos<p 

y = R cqs6sinct> 
2 = R sin6 

As with the first embodiment the location of multiple 
sensors is facilitated because the generating coils are only 

20 energised sequentially allowing the generated field to be 
simultaneous measured at any number of locations. 

Although in both embodiments of - the invention 
described herein the voltages induced in the sensor coil 7 by 
the generating coils 3 are distinguished one from the other 

25 by employing a time multiplexing approach, i. e. the 
generating coils are energised sequentially, a frequency 
multiplexing approach may also be adopted within the scope of 
the present invention- For example in such an approach, each 
generator coil 3 could be driven at a different frequency so 

30 that a plurality of generating coils 3 could be 
simultaneously energised while still allowing the voltage 
induced in the sensor 7 by each generating coil to be 
distinguished by its frequency. In such an arrangement the 
sensor would need zz be responsive io all the energising 

3 5 frequencies and some form of frequency filtering would need 
• to be provided. This filtering could be provided by discrete 
physical bandpass filters electrically connected to the 
sensor 7 , or, iif an A to D converter is employed as described 
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herein, filtering of the signal from the sensor 7 can be 
accomplished by signal processing software in the controller 
6. The use of frequency multiplexing to acquire the data for 
position determination can significantly increase the 
5 operating speed of the positioning system since measurements 
from generating coils can be taken simultaneously. 
Disadvantages of such a frequency multiplexing system are 
that it is more complex than a time multiplexed system and 
requires greater electrical bandwidth, A combination of time 

10 and frequency multiplexing could of course be used. 

In both embodiments it is desirable that the quasi- 
static magnetic field generated by a coil is established 
quickly and is allowed to decay quickly. For this reason it 
is preferred to use a first order rather than a second orjler 

15 drive circuit. For the generating coils employed the field 
settles within one cycle of being switched on. 

It will be appreciated that alternative configurations 
of both embodiments for different applications, for example 
locating a sensor within a two dimensional plane, are 

20 envisaged within the scope of the present invention. 

As will be clear to one skilled in this art, the roles 
of the generating and sensing coils may be reversed while 
still benefitting from the advantages of the present 
invention. That is the sensing coil or coils may be used as 

25 field generating elements, and the generating coils may be 
used as field sensing elements. 

This reversal of roles has particular advantage where 
a static field, such as that generated by a bar magnet is 
employed according to the first aspect of the invention, 

30 since such a field generating element must be effectively 
permanently "energised". The reversal of roles allows the 
"sensor" permanently to generate a field which is sensed at 
each of the J generating elements" and the location and 
orientation of the " sensor-* is then determined as before. 
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Appendix A 

r™*i*~ a current. I. flowing ihrongh a snail planar coflef ^ A-l). The 
fr^^nry nf t i> r f™ «* m he mmdgaitv low sncatnat sane finrt mnnmrnniTi gppfr. 




Fbra pcrimP in the field whose distance Rftam the e**"*!**?^**^^ 
Swnte Example in 0 K Cheng, Field and Wave Electromagnetics, 2nd Ed, 
Addison Wesley, 1989, that 

n 2 fee cos 6 (A-l) 

*" R 3 

and. 

psm« _ (A-2) 
R 3 



B« = 



wbcKkcisakiiownfimenonoflandb. B B andB fl lenxesentdje ' 

fbx deaay ax poi« P «olvedaloa£a^ 
augS-Nom mar. by coWnnon. 6 is measorcdtotiieaxaof tbecci 

la oder to raoive the oagneric flux ^^jJ^S^^f: 
SSie^iem.consiiiermsitnec^ 

2). 

2 A 
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If point P is distance x from the coil (Le. origin) along the x-axj^jndjts vector 
distance is R. the distance in the y-z pl ane bv Pythagoras is YR 2 - x 2 . Since 
£2 _ x 2+y2 + z 2 f this distance reduces to Vy^ + z 2 , as shown. It then follows that. 



sine = 



Vv 2 



and. 



.-(A-3) 
..-.(A-4) 



Resolving the magnetic flux density at P onto a cartesian system gives, forme x-axis 
component, 

B, = Br cos 6 -B e sin 6 
Bom (A-l) and (A-2) this becomes. 



and from ( A-3) and (A-4), 



B x = -M 2 cos 2 8 - sin 2 6 ) 
R 

b,^ 2 * 2 ^ 2 -* 2 ) 

R 5 



...-(A-5) f 



Resolving similarly onxo the y-z plane gives, 

Byz = B R siii<i> + BeCQS$ 
which from (A-l) and (A-2) becomes. 



and from (A-3) and (A-4), 



Byx = -^(3 cos9 sine) 

By, = -M IxJyST*) 
R s 



.(A-6) 




*• y 



F fc A-"V Resoivin? the mnrnrnc flux density at P onro The v-7 plane. 
Resolving me magnetic flux density at P into its y and z components (Fig A-3) gives. 
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ana, z 
B z = Bvzsinb = Byz 



[Vy 2 + z 2 
From (A-6) these become, 

B y = ^{3xy) .~~<A-7) 
R 3 

B t = ^-(3xz) — ( A " 8 > 

For a coil (diode) in the y-z plane, equations (A-5). (A-7) and.(A-8) folly describe the 
reolvS cEan components of the magnetic flux density ax a point P located la ^a 
Sal distance Rfrom the coiL THe carrrsponoing equanons fo cob » «**; 
zphncs can be developed in an identical manner. The complete set of formulae can 
therefore be summarised thus. 



For a coil in&ey-z plane :- 



For a coil in die x-y plane : 



For a coil in die x-i plane :- 



B. = ^£-(2x 2 -y 2 -z 2 ) (A-9) 

By =^(3xy) ~~<A-10) 

Bl = ^(3w) ~..<A-11) 
R 5 



B x = -^(3xz) — (A-12) 
R 5 

B y « J£s.(3yz) — (A-13) 
R 5 

Bl = -^(2z2-x2-y2) -.-(A-14) 
R 5 



B x =*M3xy) --(A-15) 
R 5 

By = JS£.( 2y 2.x-z2) ._(A-16) 

R 3 

B z = -^-( 3yz ) — (A-17) 
R 5 
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CLAIMS 

1. A method of determining the location of a field sensor 

relative to a plurality of field generators of known 
location, each field generator comprising a plurality of co r 
5 located field generating elements, the method comprising the 
steps of: 

1) for each generator, energising each generating 
element and measuring the respective field 
generated by each generating element at the field 

10 sensor, 

2) for each field generator calculating, from the 
measurements of the fields generated by each of 
its generating elements, an estimate of the 
distance from that particular field generator* to 

15 the sensor, and 

3) utilising the estimates of the distances from 
each of the field generators to the sensor, and 
the known location of the field generators to 
calculate the location of the sensor relative to 

20 the field generators. 

2. A method as claimed in claim 1, wherein in step ,1) 

each generating element of each field generator is energised 
in sequence so that only one generating element is energised 
at any given time. 

25 3. A method as claimed in claim 1, wherein in step 1) at 

least two generating elements are simultaneously energised, 
each of these at least two generating elements being 
energised at a different frequency from the other 
simultaneously energised generating element (s). 

20 4. a method as claimed in any one of claims 1, 2 or 3 for 

determining the location of a field sensor and for further 
determining the orientation of said sensor, thfe method 
further comprising the steps of: 
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4) employing the location of the sensor calculated 
in step 3), and a knowledge of the form of the 
field generated by a field generating element, to 
calculate an estimate of the orientation of the 

5 sensor relative to each of the field generators, 

5) repeating steps 2) to 4) iteratively until the 
location and orientation of the sensor relative 
to the field generators is found to a desired 
level of accuracy. 

10 5. A method as claimed in any one of claims 1, 2 or 3 for 

determining the location of a field sensor and for further 
determining the orientation of said sensor, the method 
further comprising the steps of: 

4) employing the location of the sensor calculated 
15 in step 3), and the known relative orientations 

of the field generating elements to calculate the 
angle of the respective field to the direction 
vector of the sensor from each field generator, 

5) calculating from the field angles and a knowledge 
20 of the form of the field generated by a field 

generating element the angle of the field sensor 
relative to each field generator, 

6) repeating steps 2) to 5) iteratively until the 
position of the sensor relative to the field 

25 generators is found to a desired level of 

accuracy, and 

7) calculating the orientation of the sensor 
relative to each of the field generators. 

6. A method of determining the iocation of a field 

30 sensor, comprising a plurality of co-located field sensing 

elements, relative ~o a field generator, comprising a 

plurality of co-located fieid generating elements, the method 

comprising the steps of: 

i) energising a single field generating element to 
35 establish a field, 
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10 



15 



20 



2) measuring a value of the field strength at the 
field sensor which is dependent on the location 
and orientation of the sensor within the field, 

3) repeating steps 1) and 2) for each field 
generating element, 

4) calculating, by utilising all the values measured 
in step 2 and an estimate of the location of the 
sensor, an estimate of the field strength B that 
would exist at the sensor if the axis of the 
field were directed towards the sensor, and 
maximising the value of B by iteratively altering 
the estimate of the location of the sensor until 
the location of the sensor relative to the fi.eld 

is found to a desired level .of 

f 

accuracy. 



5) 



7. . Apparatus for determining the location of a field 
sensor comprising: 

a plurality of field generators each comprising a 
plurality of field generating elements, 

energising means operable for each field generator to 
energise each of the plurality of field generating . elements 
to produce a field within which the location of the object 
may be determined, 

measurement means, connected to the field sensor, for 
25 measuring and outputting a parameter. of the field at the 
sensor, 

control means for controlling the energising means, 
storing parameters output by the measurement means, and 
calculating the location of the sensor relative to the 
plurality of field generators. 

3. Apparatus as claimed in claim 7, wherein the 
energising means are operabie to sequentially energise" each, 
field generating element. 

9. Apparatus as claimed in claim 7 wherein the energising 
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means are operable to simultaneously energise at least two 
field generating elements, and to energise each 
simultaneously energised field generating element at a 
distinct frequency. 

5 10. Apparatus for determining the location of a field 
sensor as claimed in any one of claims 7, 8 or 9, wherein the 
field sensor comprises a single field sensing element and the 
parameter of the field sensed by said single field sensing 
element is dependent on the orientation of the field sensing 
10 element within the field. 

11. Apparatus for determining the location of a field 
sensor as claimed in claim 10, wherein the field sensing 
element comprises a coil of electrically conducting wire. 

12. Apparatus for determining the location of a field 
15 sensor as claimed in any one of claims 7 to 11, having three 

field generators, each comprising three mutually orthogonal 
co-located field generating elements, 

13. Apparatus for determining the location and orientation 
of a field sensor as claimed in any one of claims 7 to 12, 

20 wherein the control means calculates the location and 
orientation of the sensor by 

estimating the distance of the sensor from each of the 
three field generators, having no regard for the orientation 
of the sensor, 

25 estimating the location of the sensor relative to the 

field generators from the estimates of the distance of the 
sensor from each field generator, and a knowledge of the 
relative locations of the three field generators, 

iteratively improving -he estimate of the location of 

20 zhe sensor, and additionally determining the orientation of 
the sensor, by including the effect of the orientation of the 
sensor in subsequent estimates of the distance of the sensor 
from each of the fieid generators. 
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14. Apparatus for determining the location of an object 
relative to a field generator, the apparatus comprising 

a field generator comprising a plurality of field 
generating elements, 
5 energising means for sequentially energising each of 

the field generating elements to produce a field within which 
the object may be locared, 

» 

a sensor, to be attached to the object, comprising a 
plurality of co-located field sensing elements, each able to 
10 sense a parameter of the field, 

measurement means for measuring and outputting the 
parameter of the field sensed by each field sensing element 
when each field generating element is energised, and 

control means for controlling the energising means, 
15 storing the parameters output by the measurement means and 
calculating the location of the sensor, relative to the field 
generator 

wherein the control means is operable to determine the 
location of the sensor by, 
20 weighting each of the parameters, sensed by the 

sensor, by a location dependent weighting factor, 

calculating from all the parameters sensed at the 
sensor an estimate of the field strength at the sensor, 

iteratively altering the location dependent weighting 
25 factors until a maximum value of the field strength is found. 

15. Apparatus for determining the location of an object as 
claimed in claim 14, wherein the field generator comprises 
three mutually orthogonal field generating elements and the 
sensor comprises three mutually orthogonal field sensing 

30 elements. 

16. Apparatus for determining the location of an object 
substantially as hereinbefore described, with reference to, 
and as shown in, the accompanying drawings. 

17. A method of locating an object substantially as 
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the accompanying drawings. 



WO 94/04938 



1/8 



PCT/GB93/01736 



Fig. 1. 
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Fig. 7. 
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Fig. 8. 
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Fig. 10. 
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